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Алгоритмы оптимального движения 
мобильных объектов по пересеченной 
местности и транспортной сети 


Исследованы алгоритмы построения оптимальных и квазиоптимальных маршрутов движения мобильных 
объектов по пересеченной местности и транспортной сети. Рассмотрены алгоритмы для комбинированных 
вариантов движения. Эффективность предложенных алгоритмов не хуже базового алгоритма Форда- 
Беллмана и зависит от сложности транспортного графа. Для построения квазиоптимальных решений 
предложен волновой алгоритм с вычислительной эффективностью, пропорциональной числу узлов 


транспортного графа. 


Введение 


Задача нахождения оптимальных путей по уровню транспортных затрат актуальна 
для ряда технических приложений. В частности, к ним относятся: оценка транспортной 
доступности для территориально-распределенных систем охраны, планирование оптималь- 
ных маршрутов движения робототехнических систем на пересеченной местности, модели- 
рование прокладки маршрутов в тренажерах мобильных систем и компьютерных играх. 

Задача планирования оптимального пути в общей постановке формулируется 
следующим образом. На карте местности необходимо определить маршрут движения от 
стартового множества точек к множеству конечных точек, обладающий минимальными 
транспортными затратами. В такой постановке начальные и конечные точки заведомо 
не известны и определяются в процедуре расчета. В частной постановке возможны 
следующие варианты задач: 

— проложить оптимальный маршрут от множества стартовых точек к заданной ко- 
нечной точке; 

— проложить оптимальный маршрут от множества стартовых точек к заданному 
множеству конечных точек; 

— проложить оптимальный маршрут от заданной стартовой точки к заданной 
конечной точке; 

— построить фронт транспортной доступности с заданным уровнем затрат по отно- 
шению к множеству стартовых точек. 

Известный базовый алгоритм прокладки оптимальных маршрутов основан 
на методе динамического планирования Форда-Беллмана на взвешенных графах 
(1956 — 1958 гг.) [1-3]. В приложении к транспортной задаче на пересеченной 
местности вершинами графа являются центры элементарных участков карты, а дуги 
соответствуют переходам между центрами смежных участков. Для транспортной 
сети вершинами графа являются узлы транспортной сети, а дуги соответствуют 
переходам между узлами. Множество алгоритмов, предложенных в последующие 
годы (алгоритмы Дейкстры, Калаба, А-звезда и др.), в основном являются вариа- 
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циями базового алгоритма для частных постановок, благодаря чему достигается 
более высокая вычислительная эффективность данных алгоритмов по сравнению с 
базовым алгоритмом. 

В настоящей работе рассматривается алгоритм оптимального планирования 
маршрутов в общей постановке. В отличие от алгоритма Форда-Беллмана маршрут 
строится в виде последовательно улучшаемых решений, причем на первом этапе для 
прокладки маршрута используется волновой алгоритм с вычислительной слож- 
ностью, пропорциональной числу узлов. На последующих этапах маршрут уточ- 
няется за счет последовательного ослабления дуг. Алгоритм завершается при 
стабилизации накопленных затрат для узлов графа. В целом вычислительная 
сложность алгоритма не превышает вычислительной сложности алгоритма Форда- 
Беллмана, однако возможность построения приближенных решений позволяет 
существенно сократить число вычислительных операций в тех случаях, когда в 
конкретной задаче требования к точности решений можно понизить. 

В разделе 1 представлен алгоритм выбора маршрута при движении по пересечен- 
ной местности. В разделе 2 представлен модифицированный вариант для использования 
в транспортной сети. В разделе 3 обсуждается построение оптимальных и квазиоп- 
тимальных маршрутов при комбинированном движении по пересеченной местности 
и транспортной сети. 


1. Алгоритм выбора оптимального маршрута 
на пересеченной местности 


1.1. Модель местности 


Карта местности представлена в виде матрицы 7 = 2(У, х), где каждый элемент 


определяет максимальные затраты на преодоление участка с координатами (, %). 
Участок местности, соответствующий элементу матрицы, считается квадратом со 
стороной 4, правильно ориентированным вдоль координатных осей. Под коорди- 
натами участка понимаются матричные индексы: у- номер строки матрицы, х — 
номер столбца. Максимальные затраты соответствуют пересечению участка по 
диагонали. Полагается, что затраты при пересечении вдоль любой координатной оси 


в 2 раз меньше максимальных. 

При переходе с данного участка на смежный участок будем считать, что 
переход осуществляется из центра одного участка в центр другого. Затраты на 
переход равны среднему значению затрат по двум смежным участкам: 


212 а +2.)/2. 
Затраты на маршруте определяются суммой затрат по всем переходам между 
точками маршрута: 


М№М-—1 
{@) = ут , 
11 


где № -— число точек маршрута. При построении оптимального маршрута на каждом 
шаге необходимо выбирать направление дальнейшего движения. Результат выбора 
называется шаговым управлением и обозначается с,. Управление всей операцией 
состоит из совокупности шаговых управлений: 
С = оо 

Маршруты задаются координатами элементарных участков карты, поэтому 
шаговые управления и накопленные затраты для множества маршрутов представ- 
ляются в виде матриц С = с(у,х) иО= а(у,х), а шаговое перемещение реализуется в 
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пределах маски размером 3 Хх 3. Это позволяет интерпретировать матрицу накоплен- 
ных затрат в виде полутонового изображения и использовать методы рекурсивной 
пространственной фильтрации для нахождения оптимальных маршрутов. Начальное 
заполнение матрицы накопленных затрат реализуется волновым алгоритмом с 
числом вычислительных операций, пропорциональным числу элементов матричной 
карты. Начальное заполнение дает первую оценку оптимальных маршрутов, которая 
в ряде случаев уже является удовлетворительной. 


1.2. Фильтрующий алгоритм 


Принцип динамического планирования Беллмана можно выразить фразой: «любая 
часть оптимальной траектории оптимальна». В частности, для любой промежуточной 
точки оптимального маршрута минимальна сумма затрат от стартового множества 
до данной точки. На основе принципа Беллмана можно предложить следующий 
вариант алгоритма решения общей задачи оптимального планирования пути. 

Начиная от точек стартового множества, строится веер оптимальных траекторий 
до тех пор, пока некоторая оптимальная траектория не достигнет какой-либо конечной 
точки. На каждом шаге алгоритма запоминается оптимальное направление перехода в 
текущую точку (шаговое управление на предшествующем шаге), что позволяет при 
достижении конечной точки восстановить весь оптимальный маршрут. 

В предлагаемом алгоритме матрица накопленных затрат О и матрица направ- 
лений С интерпретируются как двумерные изображения. Значение каждого элемента 
матрицы соответствует уровню яркости изображения. Алгоритм построения веера 
оптимальных траекторий реализуется как многоступенчатый пространственный пара- 
метрический ранговый фильтр минимума с маской размером 3х3 (рис. 1). 


0%) — Ро 


(5х) — К 


о-Ьх-1) | -Ьх) | ©-Ьх+1 
(,=-1 | (›х) | б,х+1 
(У+Ьх-1) (у+Ьх) (у+Ьх+1 


Рисунок 2 — Маска пространственного фильтра 
Фильтрация производится над матрицами накопленных затрат О=а(, х) и 
матрицей шаговых управлений С = с(у,х). Матрица 7 = 2(у,х) определяет параметр 
фильтра для каждой точки (элемента) матриц О и С. Веер траекторий строится от 
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множества стартовых точек и распространяется по всем направлениям карты. 
Эффект пространственной фильтрации матриц эквивалентен ослаблению дуг в 
алгоритме Форда-Беллмана. 

Размещение фильтрующей маски в точке с координатами (у, х) показано на 
рис. 2. Число ступеней фильтра заведомо не определено, каждая ступень улучшает 
предыдущее решение. Матрица затрат Х содержит относительные затраты, при- 
веденные к диапазону [0,1] (0 — минимальные затраты, 1 — максимальные затраты в 
пределах зоны). Непреодолимые области имеют значение с. Матрица может иметь 
необрабатываемые области, которые помечены символом МаМ (символика Матлаб). 
Значение элемента матрицы 2(у, х) используется как параметр пространственного 
фильтра в точке (у,х). Матрица накопленных затрат О = а(у,х) имеет размер мат- 
рицы 7 и содержит следующие области: 

— необрабатываемая область — точки помечены символом МаМ. При выполнении 
пространственной фильтрации эти точки пропускаются и не участвуют в обработке; 
— стартовые точки (в пределе это может быть одна точка) определяют границу, от 
которой распространяется волновой процесс накопления затрат. В начальном сос- 
тоянии стартовые точки заполняются соответствующими значениями из матрицы 
затрат 7; 

— точки, до которых волновой фронт еще не дошел — имеют значение с. В про- 
цессе выполнения алгоритма значение этих точек изменяется и в конце первой 
ступени алгоритма содержит оценку минимальных затрат на движение от множества 
стартовых точек к данной точке. 

Матрица шаговых управлений С = с(у,х) имеет размеры матрицы /. Каждая 
ячейка матрицы содержит структуру из двух координат. В процессе выполнения 
алгоритма в ячейках матрицы С устанавливаются значения координат, которые 
указывают на соседнюю предшествующую точку оптимального маршрута. Можно 
сэкономить память, если вместо пары координат в ячейке с(у,х) сохранять кодовый 
номер направления на соседнюю точку. Таких направлений всего 8 (рис. 3). 


Рисунок 3 — Возможные варианты шаговых управлений 


При пространственной фильтрации в классическом варианте маска последо- 
вательно перемещается вдоль строк и столбцов изображения, формируя новые 
значения яркости. Однако в данном случае на первой ступени фильтрации такая 
реализация оказывается неэффективной, поскольку большинство точек матрицы О 


(имеющих бесконечные значения) не граничат со стартовыми точками и поэтому не 
изменяют свое значение, но, тем не менее, будут просматриваться сканирующей 
маской. 

Поэтому на первой ступени фильтрации маска перемещается только вдоль 
границы, отделяющей настоящее и прошлое движение от будущего. Вначале граница 
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охватывает только стартовые точки, а затем, по мере построения веера оптимальных 
траекторий, она распространяется в виде волны по всей плоскости матрицы О. 

При движении маски вдоль границы только часть точек, покрываемых маской, 
может быть использована для вычисления накопленных затрат. Это означает, что в 
процессе вычисления шаговых управлений будут пропущены некоторые направле- 
ния из-за того, что будущее движение нам пока не известно. После первой ступени 
фильтрации будут получены оценки накопленных затрат для всех точек матрицы О 


(оценки первого приближения). При этом в матрице направлений С(, ” все эле- 
менты будут содержать направления маршрута первого приближения. 

Последующие ступени фильтрации позволяют уточнить первое приближение. 
Поскольку после первой ступени матрицы О и С полностью определены, то на 
последующих ступенях фильтрации сканирование маской выполняется последова- 
тельно по строкам и столбцам, при этом фильтр маски использует все восемь 
возможных шаговых управлений (рис. 3). 


1.3. Реализация алгоритма 


Ступень [. На первой ступени фильтрации алгоритм распространяется от стар- 
товых точек в виде волны. Фронт волны строится следующим образом. Множество 
стартовых точек рассматривается как начальный фронт волны. Маска позицио- 
нируется в стартовую точку карты и в матрицах затрат Й, О просматриваются все 


точки, покрываемые маской. Точки, для которых значения в матрице ( равны оо, а 
значения в матрице О конечны, переносятся в список граничных точек. Просматри- 


ваются все стартовые точки и строится общий список. Далее список редактируется, 
из него удалятся повторяющиеся точки (редактирование может производиться и при 
смене позиции маски). Логические условия построения нового фронта имеют вид: 


(у,х) е Етош, если |4(›,х) = & 2(у,х) == 0, МаМ & а(’,х) =} (1) 


где координаты у и х принадлежат полю движущейся маски, у’,х — координаты 
точек текущего фронта волны. Фильтрация выполняется для всего списка граничных 
точек. С этой целью маска позиционируется центром в граничную точку (у,х) и 
выполняется вычисление нового значения накопленных затрат по следующему 


правилу: 
а(’,х)= ат +х+Й+2 , (у, 5), (2) 
где = 0, =1 — индексы маски с ненулевыми значениями элементов. Полагается, 


Что 209 (, х) =0. В центральных областях карты матрица фильтрующей маски имеет 
вид: 


111 
Мазка = 1 1 1 
111 


Матрица маски наполняется нулями при пересечении границы карты. Значение 
соответствующего элемента матрицы шаговых управлений устанавливается по пози- 
ции точки минимума в выражении (2): 


с(у,х) = агетит(а(у + >х+1) +2, (уьх)). (3) 


› 
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Полученный фронт используется для построения нового списка граничных 
точек. Процедура волновой фильтрации повторяется для нового списка граничных 
точек. Итерационный процесс заканчивается, когда новый фронт не содержит ни 
одной точки. После выполнения первой ступени все точки матрицы накопленных 
затрат, которые были равны со, получают конечное положительное значение. 

Ступень 2 и последующие. Последовательно просматриваются все точки карты, 
для которых а(у, х)= № М и выполняется коррекция значений матриц О и С, 
следуя формулам (2) и (3). Фильтрация заканчивается, когда матрицы О двух смеж- 
ных ступеней совпадают. Дополнительный эффект ускорения вычислений дости- 
гается за счет рекурсивного принципа фильтрации. 

Построение оптимального маршрута. При построении маршрута возможны 
следующие варианты: 

1. Стартовых точек несколько. Необходимо проложить маршрут от ближайшей 
стартовой точки к заданной конечной точке с координатами (у из в В этом случае 


точки маршрута восстанавливаются по цепочке шаговых управлений: 


ы сур, х № ыы су \5 у. 

2. Конечная точка не задана, но определено множество, которому она принад- 
лежит. В этом случае на заданном множестве необходимо найти точку, в которой 
а(у, х) —> т и далее повторить алгоритм пункта 1. 

3. Если заданы начальная и конечная точки, то алгоритм необходимо выпол- 
нить для начального фронта, состоящего из одной стартовой точки. 

Построение фронта транспортной доступности. В матрице накопленных 
затрат ищутся точки, удовлетворяющие условию: 4 ( уж} = Г, где Г. уровень затрат 


на линии фронта. Степень приближения может быть задана, например, в процентах 
от уровня ДС. 


2. Алгоритм оптимального движения в транспортной сети 


2.1. Модель транспортной сети 


Транспортная сеть (рис. 4) представляется топологической моделью в виде 
взвешенного графа С. Ребра графа соответствуют однородным сегментам транспортной 
сети, а узлы — точкам ветвления или иным точкам интереса (стартовым точкам, конечным 
точкам, точкам сети, ближайшим к заданному объекту и т.д.). Каждому ребру графа 
поставлено в соответствие значение временных затрат на преодоление сегмента. 
Сегментные затраты определяются геометрической длиной сегмента и средней ско- 
ростью движения объекта вдоль сегмента. 

Постановка задачи по прокладке маршрута в транспортной сети не отличается 
от задачи маршрутизации по пересеченной местности. 


2.2. Описание алгоритма 


Обозначим через 5 множество стартовых точек и через Е множество конеч- 
ных точек. Для каждого узла сети введем понятие накопленных затрат. Накопленные 
затраты определяются минимальными суммарными затратами на перемещение из 
ближайшей стартовой точки в данную точку. 

Начиная от точек стартового множества, строится веер оптимальных траекто- 
рий до тех пор, пока некоторая оптимальная траектория не достигнет какой-либо 
конечной точки. В каждой узловой точке производится вычисление минимальных 
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накопленных затрат по отношению к ближайшей стартовой точке. Кроме того 
запоминается сегмент оптимального маршрута (оптимальное шаговое управление на 
предшествующем шаге), что позволяет при достижении конечной точки восстано- 
вить весь оптимальный маршрут. 


Рисунок 4 — Транспортная сеть 


2.3. Реализация алгоритма 


Взвешенный граф транспортной сети задается квадратной матрицей затрат 
= 2(1, 7). Размер матрицы определяется числом вершин в графе. Каждый элемент 
матрицы представляет собой затраты на перемещение между смежными вершинами. 
В общем случае матрица может быть не симметрична (2(: р ) = 2( Я )). Если вершины 
не являются смежными, то значение элемента матрицы равно <. Кроме того 
элемент матрицы может иметь 0, если 1 = / или значение МаМ (символика Матлаб) — 
такой сегмент не участвует в построении оптимального маршрута. 

Накопленные затраты сохраняются в массиве О. Каждый элемент массива 
соответствует вершине графа. Первоначально всем элементам массива О присваи- 
вается значение с. Элементу массива О присваивается значение МаМ, если все 
сегменты окружения для соответствующей вершины графа имеют значение МаМ. 

Ступень [. На первой ступени алгоритма накопление затрат происходит в виде 
волны от стартовых точек. Фронт волны строится следующим образом. Множество 
стартовых точек рассматривается как начальный фронт волны. Алгоритм фокуси- 
руется в стартовой точке, в матрице весов Г и массиве накопленных затрат О. 
Просматриваются все сегменты и узлы ближайшего окружения. Точки, для которых 
значения в массиве О равны со, и при этом соответствующие значения в матрице 
сегментных затрат Г конечны, переносятся в список граничных точек. Просмат- 
риваются все стартовые точки и строится общий список. Далее список редакти- 
руется, из него удалятся повторяющиеся точки. Логическая формула построения 
нового фронта имеет вид: 

Ге ЕготЁ если {9(г) = о & 2(р, |) = ®, Мам}. (4) 

Фильтрация первой ступени'. Алгоритм фокусируется в граничную точку # и 
выполняется вычисление нового значения накопленных затрат, следуя правилу: 


4(()= ша (9(7)+=„). (5) 
Теа '(#) 


1 
Применительно к графам используется терминология «ослабление дуг». 
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Значение соответствующего элемента массива шаговых управлений устанавли- 
вается по позиции точки минимума в выражении (5): 


с(2) = аго „ов 0) +2) } (6) 


Когда все точки текущего фронта пройдены, строится новый фронт по выше- 
рассмотренному алгоритму. Итерационный процесс первой ступени заканчивается, 
когда новый фронт не содержит ни одной точки. После выполнения первой ступени 
все точки массива накопленных затрат О, которые были равны ©, получают 
конечное положительное значение. 

Ступень 2 и последующие. Последовательно просматриваются все точки зоны, для 
которых (2) = №МаМ\№М и выполняется коррекция значений, массивов О и С, следуя 
выражениям (5) и (6). Фильтрация заканчивается либо когда массивы двух смежных 
ступеней совпадают, либо после выполнения заданного числа ступеней фильтрации. 

Построение оптимального маршрута. При построении маршрута возможны 
следующие варианты: 

1. Стартовых точек несколько. Необходимо проложить маршрут от ближайшей 
стартовой точки $, к заданной конечной точке е,. В этом случае узловые точки 


маршрута восстанавливаются по цепочке шаговых управлений: 1, = с(ь) Е 


2. Конечная узловая точка не задана, но определено множество, которому она при- 
надлежит. В этом случае на заданном множестве необходимо найти узловую точку, в 
которой а( т ) —> шш и далее повторить алгоритм пункта 1. 


3. Если заданы начальная и конечная узловые точки, то алгоритм формирования 
массива накопленных затрат необходимо выполнить для начального фронта, 
состоящего из одной стартовой точки. 

Построение фронта транспортной доступности. 

Фронт транспортной доступности представляет собой линию (изохрону), в каждую 
точку которой можно попасть из стартовой точки примерно при одном и том же уровне 
затрат Ё. В массиве накопленных затрат О ищутся точки, удовлетворяющие условию: 


а( ) = Ё. Степень приближения должна быть задана (например, в процентах от уровня /[.). 
Узловым точкам изохроны соответствуют координаты (х,, у;). По этим координатам 


можно приближенно построить фронт транспортной доступности, соединив их отрезками 
прямых линий. 


3. Алгоритм прокладки оптимального маршрута 
при комбинированном движении 


Комбинированное движение состоит из этапа движения по транспортной сети с 
использованием транспортных средств и этапа движения по пересеченной местности. 


3.1. Построение первого приближения 


1. С помощью волнового алгоритма определяются достижимые затраты на 
перемещение из стартового узла во все узлы транспортной сети. 

2. Узлы транспортной сети рассматриваются как стартовые точки для оптималь- 
ного алгоритма движения по пересеченной местности, причем для стартовых точек зада- 
ется начальный уровень затрат, полученный при расчете движения по транспортной сети. 

3. С помощью волнового алгоритма рассчитывается оптимальный маршрут 
движения по пересеченной местности от множества стартовых точек. 
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4. Выделяется оптимальная стартовая точка (узел транспортной сети, принадле- 
жащий оптимальному маршруту). 

Точность первого приближения определяется максимальным расстоянием между 
оптимальной стартовой точкой и смежными с ней узлами. 


3.2. Уточнение решения 


1. Сегменты транспортной сети, инцидентные оптимальной стартовой точке, 
детализируются дополнительным числом узлов. 

2. С помощью волнового алгоритма определяются достижимые затраты на 
перемещение из стартового узла к вновь образованным дополнительным узлам 
транспортной сети. С помощью этапов фильтрации (ослабления дуг) уточняется 
решение на транспортной сети. 

3. Множество дополнительных узлов сети вместе с оптимальной стартовой 
точкой рассматриваетсяё как стартовые точки для оптимального алгоритма 
движения по пересеченной местности, причем для стартовых точек задается уровень 
затрат, полученный при расчете движения по транспортной сети. 

4. С помощью волнового алгоритма рассчитывается оптимальный маршрут 
движения по пересеченной местности от множества стартовых точек. 

5. Выделяется оптимальная стартовая точка. 

6. При необходимости построения точного маршрута выполняются этапы фильт- 
рации в алгоритме движения по пересеченной местности. 


Заключение 


Представленные алгоритмы покрывают практически значимые варианты проклад- 
ки оптимальных маршрутов. Быстродействие алгоритмов зависит от требуемой точности 
построения маршрута. Для построения квазиоптимальных решений достаточно огра- 
ничиться волновым алгоритмом. В этом случае вычислительные затраты минимальны и 
пропорциональны числу узлов транспортного графа. Дополнительные этапы фильтрации 
(ослабления дуг) обеспечивают улучшение решений в пределе до оптимального, при этом 
вычислительная эффективность интегрального алгоритма будет не хуже базового алго- 
ритма Форда-Беллмана. Число дополнительных этапов фильтрации зависит от сложности 
транспортного графа. Поэтому для конкретной задачи использование предложенных 
алгоритмов может оказаться значительно более эффективным, чем использование базо- 
вого алгоритма. 
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О.Ю. Дорогов, В.Ю. Лесних, 1.В. Раков, Г.С. Гтов 

Алгоритми оптимального руху мобльних об’ектв по переченй месцевост! 1 транспортный мереж! 
Дослджено алгоритми побудови оптимальних 1 квазюптимальних маршрупв руху мо@льних об’екпв по 
пересчешй мисцевост! 1 транспортй мереж!. Розглянуто алгоритми для комб\нованих варанив руху. 
Ефективнасть запропонованих алгоритмав не грше базового алгоритму Форда-Беллмана 1 залежить вд 
складност! транспортного графа. Для побудови кваз1оптимальних ришень запропоновано хвильовий 
алгоритм з обчислювальною ефективнстю, пропоршиною числу вузлв транспортного графа. 
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